#include <Arduino.h>
#include "radio.h"
#include "Metro.h"

const int pin_SETA = 4;
const int pin_SETB = 3;
const int pin_AUX  = 2;
const int INT_AUX  = 0;

Metro wakeup_rx_tmr = Metro(200,true);

static void radio_AUX(void);

void radio_init(void)
{
  pinMode(pin_SETA,OUTPUT);
  pinMode(pin_SETB,OUTPUT);
  pinMode(pin_AUX,INPUT_PULLUP);

  //Serial.begin(9600);

  //radio_standby();
}

void radio_standby(void)
{
  digitalWrite(pin_SETA,HIGH);
  digitalWrite(pin_SETB,LOW);
  attachInterrupt(INT_AUX,radio_AUX,FALLING);
  
  Serial.println("Radio:standby");
  //sys_sleep();
}

void radio_wakeup(void)
{
  detachInterrupt(INT_AUX);
  digitalWrite(pin_SETA,LOW);
  digitalWrite(pin_SETB,LOW);	
  
  //Serial.println("Radio:wakeup");
}

void radio_AUX(void)
{
  /*
  Serial.println("radio:AUX");
  wakeup_rx_tmr.reset();
  while(!wakeup_rx_tmr.check())
  {
    if(Serial.available())
    {
      radio_wakeup();
      return;
    }
  }
  */
  //sys_sleep();
}

